A NONLINEAR OBSERVER FOR GYRO ALIGNMENT ESTIMATION 


J. Thienel* and R.M. Sanner^ 

A nonlinear observer for gyro alignment estimation is presented. 

The observer is composed of two error terms, an attitude error and 
an alignment error. The observer is globally stable with 
exponential convergence of the attitude errors. The gyro alignment 
estimate converges to the true alignment when the system is 
completely observable. 

INTRODUCTION 

Combined observer-controller designs for the attitude control of rigid flight vehicles 
are a subject of active research 1 . Successful design of such architectures is complicated 
by the fact that there is, in general, no separation principle for nonlinear systems. In 
contrast to linear systems, “certainty equivalence” substitution of the states from an 
exponentially converging observer into a nominally stabilizing, state feedback control 
law does not necessarily guarantee stable closed-loop operation for the coupled 
systems 2,3 . 

One version of this problem, in particular, is the task of forcing the attitude of a rigid 
vehicle to asymptotically track a (time-varying) reference attitude using feedback from 
rate sensors with alignment errors. Alignment errors are typically estimated using a least- 
squares approach, or an extended Kalman filter 4 ' 8 . Here, in order to determine the 
misalignment errors, we propose utilizing an angular velocity observer similar to the 
observers in refs.l and 9, using the estimated misalignment state in the nonlinear 
observer presented in ref. 10. In the analysis below we demonstrate that the resulting 
system provides stable estimation of the alignment states. 

The main proof proceeds in two' steps. First, we extend the analysis of ref. 1 to the 
case of gyro misalignment first for a spacecraft with a constant angular velocity. Given 
the necessary observability conditions, we demonstrate that the alignment estimate 
converges to the true alignment. We extend the analysis for the case of a time varying 
angular velocity. The proof in ref. 1 uses a Lyapunov argument to obtain a similar result, 
but under the assumption that the alignment errors are small; this restriction is removed 
here. 

DEFINITIONS 

The attitude of a spacecraft can be represented by a quaternion, consisting of a unit 
rotation vector e, known as the Euler axis, and a rotation (j) about this axis, given as 
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where q is the quaternion, partitioned into a vector part, € and a scalar part, r). 
Typically, in spacecraft attitude applications, the quaternion represents the rotation from 
an inertial coordinate system to the spacecraft body coordinate system. Note that ||q|| = 1 
by definition. The rotation matrix for a specific attitude can be computed as 1 1 

R(q) = (r| 2 - e T e)I + 2e 6 T - 2r|S(e) (1) 

where S(e) is a matrix representation of the vector cross product operation. 
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A rotation between coordinate frames is computed as 
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Where q defines the rotation from the frame defined by q 2 to the frame defined by q, 
Note that ||7|| = 0, rj = ±1 indicates that frame 2 is aligned with frame 1. 

The kinematic equation for the quaternion is given as 


q(0=[^] = iQ(q(t))R g (q g )w g (t) 
where 
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The kinematic equation for an attitude matrix is 11 
R(q(t)) = -S(R g (q g )w g (t))R(q(t)) 
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CDg(t) is the spacecraft angular velocity with respect to inertial space, in gyro coordinates, 
transformed to body coordinates with the alignment matrix R g (q g ). R g (q g ) is computed 
from (1) above with the constant gyro alignment quaternion given as 




The angular velocity is typically measured by a gyro, which can be corrupted by 
various errors, such as bias, alignment, scale factor errors, and noise. In this work we 
consider the case of alignment errors, where the matrix R g (qg) is unknown. 

NONLINEAR OBSERVER 

Following the development in Ref. 10, observers for the attitude and gyro alignment 
quaternions are given as 

4,(t) = i Q(q 0 (ml (q„ (t))(R g (q g (t))u g (t) + k? 0 (t)sign(rj 0 (t))) (6a) 

4 g (t)=iQ(q g (t))w g (t) (6b) 


where q 0 represents the transformation from inertial coordinates to the attitude observer 
coordinates, and R g (q g )co g is the estimated angular velocity, transformed to observer 

coordinates with R^ (q 0 ) . The attitude error quaternion, q 0 , is computed as in (2) with q 
and q 0 , respectively. In Eq.(6b), q g represents the transformation from gyro coordinates 

to an intermediate coordinate frame, denoted as b , and « g is the angular velocity of the 

b frame with respect to the gyro frame, which is yet to be specified. 

Taking the derivative of q 0 , and substituting in Eq. (3) and Eq. (6a) results in the 
following kinematic equation for the attitude error quaternion 

q 0 (t) = i Q(q 0 (t))(R , (q g )« g (t) - R g (q g (t))co g (t) - k? 0 (t)sign(rj 0 (t))) (7) 

Define the difference in the two angular velocity terms in Eq. (7) as 

ffi(t) = R, (q , )U , (t) ■ - R, (q , (t))u , (t) (8) 


First, consider the case where to is constant. As in Ref. 1 0, a Lyapunov function is 
given as 
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The derivative of V 0 (t) is 
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Noting that ? 0 T (t)? 0 (t) + rj 0 (t)rj 0 (t) = 0 and substituting rj 0 (t) from Eq. (7) into Eq. 
(10) yields 

V 0 (t) = -|? 0 T (t)? 0 (t) + ^? 0 T (t)m(t)sign(rj 0 (t)) + m T (t)m(t) (11) 

If m(t) is defined as 

m = -^-? 0 sign(f| 0 ) (12) 

The derivative of the Lyapunov becomes 

V(t) = -|? 0 T (t)? 0 (t) (13) 

Given that V 0 (t) in Eq. (9) is lower bounded, and Eq. (10) shows that V 0 (t) < 0, ? 0 and 
m are bounded. V 0 (t) is a continuous, twice differentiable function, with V 0 (t) bounded. 
Applying Barbalat’s lemma 2 shows that, in fact, ||? 0 (t)|| -» 0. 

In order to determine a form for w (t) in Eq. (6b), the derivative of m , as given in 
Eq. (8), is computed as 


m(t) = -R g (q g (t))« g =S(« g (t))R g (q g (t))« g (14) 

Equating Eq. (12) and Eq. (14) 

i? 0 (t)sign(ii 0 (t)) = S(R g (q g (t))w g )w g (t) ' (15) 

Since w g (t) is an observer design variable, it is designed to be perpendicular to 
R g (q g (t))co (any parallel component does not appear in Eq. (15)). This results in 

w g (t) = |sign(rj 0 (t))S(? 0 (t))R g (q g (t))w g 

The above Lyapunov analysis shows that the errors ? 0 and m are stable and bounded. 
Therefore, as in Ref. 10, the system can be analyzed as a linear time varying system. Let 
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As shown in Ref. 10, this system is exponentially stable. In other words, both ||? 0 (t)|| and 
||m(t)|| converge to zero exponentially fast. 

The convergence of m(t) does not guarantee that the gyro alignment estimate q g (t) 
converges to the true gyro alignment, q g . Rewriting Eq. (7) as 

m(t) = (I-R^(q g (t)) W 

Given that (I - R g )? g = 0 , the error, m(t) , is zero when the angular velocity term, co (t) 

is parallel to ? g (t) , or, ideally, when ||? g (t)|| = 0 indicating that the estimated alignment 

quaternion is equal to the true alignment quaternion. Given that the convergence of the 
attitude error is exponential for a constant angular velocity, a series of discrete attitude 
changes provides observability of the gyro alignment errors, allowing convergence of q g 

t0 V 

Next, consider next the case where co is not constant. In this case, the derivative of 
m(t) , given in Eq. (8), becomes 

ffi(t) = (I - R g (q s (t))«(t) - ^(R g (q, (t))w(t)) (16) 

Inserting (16) into (11), along with (15) results in 

V 0 (t) = ?J (t)? G (t) + m T (t)ffi(t) = ? 0 T (t)? 0 (t) + co 7 (t)(I - R g (q g (t))(I-Rj(q g (t))«(t) 

Using Eq. (1) to expand R g (q g (t)) in terms of the quaternion components gives 

V 0 (t) = -l ? 0 T (t)? 0 (t) + ? g T (t)(<o T (t)d> (t) - w (t)co T (t))? g (t) (17) 

If w T (t)d) (t) < 0 due to co (t) changing direction and/or decreasing in magnitude, (17) 
can be rewritten as 

V.(t)S-^|f.(t)fl; -8||m(tf (18) 

using ||l-R|| 2 =2||e|| 2 . Since V o (t)<0, ||? 0 (t)|| and ||m(t)|| converge to zero 

exponentially fast. Again, this does not guarantee that ||? g (t)|| converges to zero. (The 

second term on the right of (17) can also evaluate to zero. The convergence then follows 
from the argument above.) 

Integrating (18) results in 



(19) 


V 0 (t)-V 0 (t 0 )<-}| |(? 0 (x)f dx + / ? g T (x)(to t ( x)to (x) - 0) (x)to T (x))e (x)dx 

Assuming that to T (t)to (t) < 0 , the integral terms are finite since the integrands converge 
to zero exponentially fast. If, however, to (t) satisfies a ‘persistency of excitation’ 
condition, such that 

t+s 

-a 2 I> | (to (t)to (t) - to (t)to T (t))dx > -a,I 

t 

for positive constants ai, ct 2 , and 5, the terms in (19) can only remain finite if ||? g (t)|| 

converges to zero exponentially fast. Intuitively, the alignment is estimated only when 
to (t) changes direction. 

SIMULATION RESULTS 

The simulation consists of the above observer equations, programmed into Matlab. 
Several scenarios are tested. The first considers a constant angular velocity, changed 
discretely at 40 second intervals about the body axes. The initial quaternions are 

qj = [l 0 0 0], q g = [0 0 0 l], q T = [0 1 0 0], q T = [0 0 0 l] 

The initial angular velocity is to J = [l 1 l] rad/sec. Figure 1 shows that the alignment 
errors converge to zero. 
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Figure 1. Magnitude of Alignment Errors Given Constant Angular Velocity, With 
Discrete Changes at 40 Second Intervals 




The next tests consider a time varying angular velocity, <*>(t) = co 0 e" klt . The initial 
quaternions and w 0 are as given above. Figure 2 shows that the alignment errors 
converge to a constant, not to zero. 
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Figure 2. Magnitude of Alignment Errors Given an Exponentially Decaying Magnitude 

Next, the angular velocity is given as u(t) = A(t)u 0 e~ k,t , where A(t) is a rotation 
matrix, computed from the (arbitrary) 3-1-2 Euler sequence of [0.3t;-0.1t;0.2t]. The 
initial quaternions and w 0 are as given above. Figure 3 shows that the alignment errors 

converge to zero. This test is repeated with random initial quaternions. Figure 4 shows, 
again, that the alignment errors converge to zero. 

Finally, the angular velocity is given as u (t) = A(t)u) 0 , with A(t) and co 0 as above. 

Figures 5 and 6 show the alignment errors given the initial quaternions above, and 
random initial quaternions, respectively. In both cases, the alignment errors converge to 
zero. 




Figure 3. Magnitude of Alignment Errors Given an Exponentially Decaying/Sinusoidal 

Angular Velocity 



Figure 4. Magnitude of Alignment Errors Given an Exponentially Decaying/Sinusoidal 
Angular Velocity with Random Initial Quaternions 
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Figure 5. Magnitude of Alignment Errors Given a Sinusoidal Angular Velocity 



Figure 6. Magnitude of Alignment Errors Given a Sinusoidal Angular Velocity with 

Random Initial Quaternions 


CONCLUSIONS 

A nonlinear observer for gyro alignment estimation is developed. The observer is 
proven, via a Lyapunov argument, to be exponentially stable given a constant angular 
velocity. The estimated alignment converges to the true alignment when the angular 


velocity is discretely changed, providing the necessary observability. Given a time 
varying angular velocity, the estimated alignment converges to the true alignment, when 
the angular velocity vector changes direction, again to provide the necessary 
observability. 

REFERENCES 

1. H. Nijmeijer and T.I. Fossen, Lecture Notes in Control and Information Sciences , New Directions 

in Nonlinear Observer Design, Springer- Verlag, 1999, pp. 135-159. 

2. H. Khalil, Nonlinear Systems , Prentice-Hall, Inc., 1996, pp. 115-1 16 and 626-629. 

3. M. Krstic, I. Kanellakopoulos, and P. Kokotovic, Nonlinear and Adaptive Control Design , John 
Wiley & Sons, Inc., 1995, p. 491. 

4. J.A. Hashmall, M. Radomski, and J. Sedlak, “On-Orbit Calibration of Satellite Gyroscopes”, 
AIAA/AAS Astrodynamics Specialist Conference, Denver, CO, August 13-17, 2000. 

5. G.Welter, J. Boia, M. Gakenheimer, E. Kimmer, D. Channell, and L. Hallock, “Variations on the 
Davenport Gyroscope Calibration Algorithm, Flight Mechanics/Estimation Theory Symposium, 
NASA Goddard Space Flight Center, Greenbelt, MD, May 14-16, 1996. 

6. J. Deutschmann (Thienel) and I.Y. Bar-Itzhack, “Estimating Attitude, Trajectory, and Gyro Biases 
in an Extended Kalman Filter Using Earth Magnetic Field Data from die Rossi X-Ray Timing 
Explorer”, Flight Mechanics Symposium, NASA Goddard Space Flight Center, Greenbelt, MD, 
May 19-21, 1997. 

7. F.L. Markley and R.G.Reynolds, “Analytic Steady-State Accuracy of a Spacecraft Attitude 
Estimator”, AIAA Journal of Guidance , Control, and Dynamics , Vol. 23, No. 6, November- 
December, 2000, pp. 1065-1067. 

8. R.L. Farrenkopf, “Analytic Steady-State Accuracy Solutions for Two Common Spacecraft 
Attitude Estimators”, AIAA Journal of Guidance and Control, Vol. 1, No. 4, July- August, 1978, 
pp. 282-284. 

9. Salcudean, “A Globally Convergent Angular Velocity Observer for Rigid Body Motion”, IEEE 
Transactions on Automatic Control, Vol. 36, No. 12, December, 1991. 

10. J.K. Thienel and R.M. Sanner, “A Coupled Nonlinear Spacecraft Attitude Observer/Controller 
With an Unknown Constant Gyro Bias”, 40 th IEEE Conference on Decision and Control, Orlando, 
FL, December 4-7, 2001. 

11. B. Wie, Space Vehicle Dynamics and Control, AIAA Education Series, 1998, pp. 318-323. 

12. R.M. Sanner, “Adaptive Attitude Control Using Fixed and Dynamically Structured Neural 
Networks”, AIAA Guidance, Navigation and Control Conference, San Diego, CA, July 29-31, 
1996. 



